Programming and Control of Robots by means ofDi erential Algebraic

| The method of programmed constraints has recently been proposed as an executable speciication language for robot programming. The mathematical structures behind such problems are viability problems for control systems described by ordinary diierential equations (ODEs) subject to user-deened inequality constraints. This paper describes a method for the numerical solution of such problems , improving and extending results presented in 1]. The algorithm presented is composed of three parts: delay-free discretization, local control, and local planning. Delay-free discretizations are consistent discretizations of control systems described by ODEs with discontinuous inputs. The local control is based on the minimization of an artiicial, logarithmic barrier potential function. Local planning is a computationally inexpensive way to increase the robustness of the solution procedure, making it a reene-ment to a strategy based on viability alone. Simulations of a mobile robot are used to demonstrate the proposed strategy. Some complementarity is shown between the programmed-constraints approach to robot programming and optimal control. Moreover, we demonstrate the relative eeciency of our algorithm compared to optimal control: Typically, our method is able to nd a solution on the order of one hundred times faster than an optimal-control solver.